# 此文件从Python to Cobot拷贝
#用于串口通讯打开串口继电器，打开三色灯
#默认主程序运行打开绿灯，当发现未佩戴安全帽时，关闭绿灯，打开红灯；再佩戴安全帽后关闭红灯，打开绿灯
import time

import serial

# 打开串口
if __name__ == '__main__':
    serial = serial.Serial('COM5', 9600, timeout=0.5)
    if serial.isOpen() :
        print("open success")
    else :
        print("open failed")

# 发送报文
def send(send_data):
    if (serial.isOpen()):
        # serial.write(send_data.encode('utf-8'))  # 编码
        serial.write(send_data)  # 编码
        print("发送成功", send_data)
    else:
        print("发送失败！")

# 调用发送函数
#默认绿灯
#发报文1为红色
data_send = [0x01, 0x05, 0x00, 0x00, 0xFF, 0x00, 0x8C, 0x3A]
#发报文2为绿色
data_send2 = [0x01, 0x05, 0x00, 0x00, 0x00, 0x00, 0xCD, 0xCA]


while True:
    send(data_send)
    time.sleep(0.5)
    send(data_send2)
    time.sleep(0.5)